#include "optical.h"
#include "lpc17xx_uart.h"
#include "lpc17xx_pinsel.h"
#include "lpc_types.h"
#include <stdlib.h>
#include "printer.h"
#define LENGTH 32




void positionTest()
{
    /* Position tests */
    
    
    opticalInit();
    int32_t one;
    int32_t two;
    one = getRelativePositionX();
    two = getRelativePositionY();
    uint8_t all[LENGTH];
    /* Reduce Values */
    //one>>2;
    //two>>2;  
    sprintf(all, "%d ; %d\n\r", one, two);
    //printString(all, LENGTH);
    
}

void lcdTest()
{
    serial_3pi_init();
    clearDisplay();
    printChar('C');
    printString("255", 3);
}


int main()
{
    lcdTest();
    //positionTest();
    while(1);
}






